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cd-Bbd = af-Bae 


85 


B(ae-bd) = af-cd 


86 


^ af-cd 
ae - bd 
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EQ 
NUMBER 


EQUATION 


87 


f af-cd\ 
\ae-bd) 

^= d 


88 


^ fiae-hd)-e{af-cd) 
d{ae - bd) 


89 


^ _ ^^f- bdf- aef+ cde 
d{ae - bd) 


90 


^ - bdf+ cde 
d(ae - bd) 


91 


^ -bf+ce 
ae - bd 


92 


^ ei 
^ ~ ES 


93 


D = ^ 
ES 


94 


e d 
E E 


95 


-d e 
b = -^G + ^FH 
E E 


96 


-e d 
g = —H+—FG 
^ ES ES 


97 


d e 
h = -^H+-^FG 
ES ES 


98 


^ eG + dFH 

E = 

a 


99 


^ -dG + eFH 
^= b 
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EQ 
NUMBER 


EQUATION 


100 


^„ -eH + dFG 
ES = 

g 


101 


dH+eFG 
ES= ^ 


102 


eG + dFH -dG+eFH 
a b 


103 


FH ad + be 
G ae-bd 


104 


-eH + dFG dH+eFG 
g ~ h 


105 


FG dg + eh 
H dh-eg 


106 


FH FG (ad + be)(dg + eh) _ 2 
G H ~ (ae-bd)(dh-eg) ~ 


107 


p — + kad + be)(dg + eh) 
~ ~'j(ae-bd)(dh-eg) 


108 


E = ±Jl-F^ 


109 


^ = arctan(£, F) 


110 


K.FH _ H _ r j(ae-bd)(dh-eg)\ .(ad+be) 
F G G \ 4{ad+be){dg + ehy {ae-bd) 

,. ((ad + be)(dh- eg) 

~ ~4(ae-bd)(dg + eh) 


111 


H H 1 



FIG. 32 



69/73 



EQ 
NUMBER 


EQUATION 


112 


H = — 
± 

'i 


1 

(1 


113 


G = ±Jl -H^ 


114 


\\f = arctan(G, H) 


1 1 O 




116 


1 2 2 
S ±Jd + e 

i E 


117 


r - ^ V ^ 

±4d + e 


118 


±A/<i + e 


119 


r. d E 


120 


^ /j2 2 
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EQ 

Ml IKADCD 


POI lATir^M 
1 \\Jvi 


121 


i(l -Ag-Bh) = IJ+ 1 


122 


sign(0 = -sign(l -Ag-Bh) 


123 


y = arctan(Z), C) 


124 


^ - DE 


125 


ei 

^ - CE 


126 


. . (ad-\-be\ 


127 


J = 


-CH+sign(FH)DFG 


128 


J = 


hi 

DH+sign(FH)CFG 


129 


(i-Agi-Bhi-l) 
J 
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o 


O 


o 


±FJ 


O 


CFJ 


O 


±HJ 


DHJ 


±FGJ 


±HJ 


DHJ+ 
CFGJ 


'5) 


o 


O 


o 


o 


±FJ 


DFJ 


±(-HJ) 


o 


-CHJ 


±(-HJ) 


±FGJ 


-CHJ+ 
DFGJ 




±BS 


±AS 


sa 


Bei 


Adi 


Adi+Bei 


±BS 


±AS 


Adi+Bei 


Bei 


Adi 


Adi+Bei 


'S 


±s 


o 


so 


±ES 


o 


CES 


±S 


o 


CS 


±ES 


o 


CES 




o 


±s 


DS 


O 


±ES 


DES 


o 


±S 


DS 


o 


±ES 


DES 


o 


±AS 


±(-BS) 


Aai+Bbi 


±AS 


±(-BS) 


Aai+Bbi 


Aai 


Bbi 


Aai+Bbi 


Aai+Bbi 


Aai+Bbi 


Aai+Bbi 


!5 


o 


±(-S) 


-DS 


o 


±(-S) 


-DS 


o 


±(-GS) 


-DGS 


±FHS 


±(-GS) 


-DGS+ 
CFHS 


■<5 


±s 


o 


SO 


CO 

-H 


o 


SO 


±GS 


O 


CGS 


±GS 


±FHS 


CGS+ 
DFHS 


X 

ef 




o 


o_ 




o_ 


o_ 


X 

o 


G,H 


X 

CD' 


G,H 


X 

CD" 


H'O 


u. 

ul 




o 


o_ 


LL 
LU 


LL 
LU 


Li. 

UJ 


o_ 


o_ 


o_ 


LL 
LU 


u. 

llT 


u. 

UJ 


o 

o" 


+1 


0,±1 


C.D 


±1,0 


0+1 


C.D 


±1,0 


0+1 


Q 
O 


±1,0 


0.±1 


Q 
O 


case 


03 


Si 

T — 


o 


OJ 
CM 


Si 

CM 


O 
CM 


CO 
CO 


-Q 

CO 


o 

CO 


CO 




o 
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description 


case 


condition 


handling 


zero pitch & 
zero roll 


1 


g = h = 0 


E<r- 1 

F<<-0 
G<- 1 
//<-0 


zero roll 


2a 


b = d = g = 0 


F/ h 
Y ~ a 


2b 


a = e =^ h = 0 


-d 

FJ _ -g 
S b 


2c 


n — h 


handle via 2a or 2b 


2 




G<r- 1 
H<r-0 

F<^sign{^Jl-E^ 



FIG. 36 
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description 


case 


condition 


handling 


zero pitch 


3a 


b = d = h = 0 


e 

S ~ e 


3b 


a = e = g = 0 


-b 

HJ _ h 
S ~ d 


3c 


if - 6 
b h 


handle via 3a or 3b 


3 




E<r- 1 

F<-0 

//= sign(^7l-G' 


non-zero pitch 
& non-zero roll 


4 


(g^O)A(/l^O) 


handle via general solution 



FIG. 37 



